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ABSTRACT 

\ . • i * v » 



The feedback control and modeling of a mobile robot with two wheels that are 
independently steerable and drivable is studied. Two-wheel steer vehicles increase their 
maneuverability when both wheels are drivable and therefore increases their performance 
in confined spaces. A dynamic feedback control algorithm is developed, which enables 
the vehicle to move from any initial configuration (position and orientation) to any final 
configuration. Simulation results are presented to verify the independent control of the 
two position variables and the orientation variable. A comparison with a two-wheel 
steering and one wheel drive vehicle shows that driving both wheels increases 
performance and maneuverability. 
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I. INTRODUCTION 



Wheeled mobile robots come in a number of different kinematic structures. 

Typical robots have a steerable front wheel(s), and the rear wheel(s) whose orientation 
relative to the vehicle body is fixed, such as an automobile or a bicycle. Some robots are 
the differential-drive type which have two co-axial wheels that are independently actuated 
to achieve forward/backward and rotational motions. The synchronous-drive type of 
mobile robots such as Nomad 200 [Ref. 1] have all the wheels steer and rotate together so 
that the wheels are parallel all the time. Mobile robots such as these have two degrees of 
freedom and are nonholonomically constrained. 

This thesis describes a type of mobile robot that has two independently steerable 
and drivable wheels. Using the bicycle as an example, this type of mobile robot would 
have both the front and rear wheels drivable as well as steerable. It has been shown that a 
mobile vehicle with two steerable wheels with one drivable can be controlled using 
dynamic feedback control [Ref. 2]. One example of this type of mobile robot is the SR2 
mobile robot from Cybermotion Inc. which has three steerable and drivable wheels [Ref. 
3]. Four-wheel steering automobiles [Ref. 4 and Ref. 5] and fire trucks [Ref. 6] are other 
examples, both of which are designed for improving maneuverability. Although these 
types of vehicles are still nonholonomically constrained, they can still be controlled to 
follow a path with independent orientation [Ref. 7] and are extremely maneuverable in 
confined space [Ref. 8]. 

This thesis focuses on modeling and control of a vehicle with two wheels, both of 
which are steerable and drivable. The vehicle has four input variables, the steering 
velocities of the two wheels and the rotational velocity of both wheels. The problem of 
how to steer and deliver the torque to the two wheels in order to independently control the 
position and orientation of the vehicle body is studied. In particular, a dynamic feedback 
algorithm is developed, which linearizes and decouples the system. The output in this 
case is the two-dimensional position and one-dimensional orientation of the vehicle body. 
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Consequently, the algorithm enables the vehicle to follow any desired position trajectory 
and orientation trajectory. Furthermore, it will be shown that the input-output 
linearization cannot be achieved by any static state feedback [Ref. 2]. Dynamic feedback 
linearization was previously applied to three-wheel mobile robots (with a free or steering 
wheel) that have only two inputs [Ref. 9]. 

One of the benefits of having both wheels drivable would include increasing the 
maneuverability the vehicle. Both wheels drivable would allow pure rotation in place and 
pure translation in the lateral direction of the vehicle. Imagine parallel parking by just 
rotating all wheels perpendicular to the body of the vehicle and laterally translating into 
the parking space. Another benefit would be the ability to have the torque distributed to 
the wheels depending on the road conditions, and if a wheel began to slip, the torque 
delivered to the wheels could be transferred to the other wheel. This would result in a 
two wheel steerable, one wheel drivable vehicle until the slipping wheel regains traction. 
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II. KINEMATIC MODEL OF THE VEHICLE 



A. NOTATIONS 

Figure 1 shows a diagram of a vehicle with two independent steering wheels. The 
two wheels are located at pi and pa on the vehicle, respectively, po is located at the center 
of gravity of the vehicle which is assumed to be located on the pi - p 2 axis. The distance 
from po to pi is a and the distance from po to p 2 is b. 

Four coordinate frames are defined for describing position and orientation of the 
vehicle [Ref. 2]. {U} is the earth-fixed coordinate frame. { 1 } is the frame fixed on 
wheel 1. Xj is chosen to be along the horizontal radial direction and yi is in the lateral 
direction. Likewise, {2} is the frame defined for wheel 2. {0} is the frame defined at 
point po- yo is chosen to be a unit vector pointing from p 2 to pi, and Xo is orthogonal to 
the line segment from P 2 to pi. 

The orientation of the vehicle body is characterized by (j) 0 , which is the angle from 
Xu to Xq. <t>i and <J >2 are two steering angles defined from Xq to X*, i = 1,2. With these 







Figure 1: Coordinate systems for a two steering wheel vehicle 
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notations, we are ready to establish homogeneous transformations describing one frame 
relative to another. In what follows, YT denotes the homogeneous transformation of 



frame {b} relative to frame {a}. Because the motion of the 
two-dimensional plane, homogeneous transformations are 3 
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B. 



VELOCITY KINEMATICS 



With the help of homogeneous transformations given above, the velocities of 
point pi and point pa can be computed. The homogeneous position vector of point pi and 
P 2 expressed in frame {0} are: 
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These points are represented in frame {U} by 
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The velocity of the points pi and p 2 (or differentiated with respect to frame { U } ) 
expressed in frame { U } are: 





-«cos(<j> 0 )<j> 0 +i 0 




bcos((j) 0 )<j) 0 +x 0 
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-asin(<|> 0 )<j> 0 + y 0 


U Pi = 


bsin(<t> 0 )<i> 0 + y 0 




0 




0 



In order to derive the nonholonomic constraint equations of wheel 1, the velocity 
of point pi relative to frame { U } is expressed in frame { 1 }: 



1 • _(u T \~ i u- _(u r o T \-'u ■ _ 
P\ ~ l p j P\ — V (r v-) Pi ~ 



cosC^o+^j) sin(<|) 0 +((),) * 
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0 0 1 



P\ 



X 0 cos(<l> 0 +()),) + y 0 sin(4> 0 + <)>,)- a<j) 0 cosO]),) 

- x 0 sin(<]) 0 + (j), ) + y 0 cos(<|> 0 + (t>, ) + a<j> 0 sin((j>, ) 

0 

where the terms indicated by * are irrelevant in the computation. Likewise, the velocity 
of point 2 relative to frame { U } is expressed in frame {2} as follows: 
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Pi = 



x 0 cos((|) 0 + <1) 2 ) + y 0 sin(<]) 0 + <|> 2 ) + b§ 0 cos(()) 2 ) 
-x 0 sin((|) 0 + (|) 2 ) + y 0 cos(<|) 0 +(|) 2 ) -bty 0 sin(<> 2 ) 



0 



C. CONSTRAINT EQUATIONS 

The vehicle is subjected to four nonholonomic constraints. The first two 
constraints are derived from the fact that the wheels cannot move in the lateral direction. 

That is, the y component of 1 /?, and 2 p 2 is zero: 

- i 0 sin(<J> 0 + <)>| ) + y 0 cos(<|> 0 +<b t ) + a<j> 0 sin(<t>, ) = 0 
-xr 0 sin(<)) 0 +(]) 2 ) + y 0 cos((]) 0 +(j) 2 ) -/?(j) 0 sin((|) 2 ) = 0 
The other two constraints are due to the no-slip condition. Let r be the radius of 
the wheels, and 0j, i=l,2 be the angular displacement of the wheels (driving angles) then 
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the x component of 1 p x and 2 p 2 is eqi 
These two constraints are expressed as 
x 0 cos(<|> 0 +4>l) + j 0 
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Choosing the following generalized coordinate vector 
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the four constraints can 
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D. KINEMATIC MODEL 

The 4x7 dimensional matrix A(q) has a 3-dimensional null space. Let 

s(4) = [jiM s Aq)] 

be a 7 x 3 full-rank matrix whose columns Sj(q), i=l,2,3, are in the null space of A(q), that 
is, A(q) Sj(q) = 0. The three columns of S(q) form a basis for the null space of A(q). 

Since the generalized velocity q is always in the null space of A(q) as characterized by 
Equation (1), it may be expressed as 

<7 = S(<7>1 (2) 

where r| is a 3-dimensional vector of independent velocities. It is noted that the choice of 
S(q) and the corresponding r| is not unique. For a certain choice, r\ may not necessarily 
represent any physical velocity. 

As stated earlier, both wheels are steerable and powered. However, only three 
velocity inputs are needed. If we choose r| to be the three angular input velocities, that is, 
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( 3 ) 
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E. DYNAMICS 



Since only one wheel rotation velocity is used as one of the inputs, the torque 
delivered to both wheels must be incorporated into this single input. This relationship is 
obtained by solving the dynamic equation for the forces. Figure 2 shows the dynamic 
forces acting on the body and wheel unit. Summing the moments about the z<) axis at the 
center of gravity yields 

=-«^i cos( t ) i +bF 2 cos §2 =/ B <f >0 (4) 

where Ib is the body moment of inertia. For the wheel, summing the moments at the 
point where wheel i, (i = 1,2) makes contact with the surface yields 

X M z = cF i + 

where Iw is the wheel moment of inertia and mw is the mass of the wheel. Since the 
acceleration a i = r9 i , 



F ; = 



Tj + 0, (/ vv + r~m w ) 



(5) 



Combining Equation (4) and Equation (5) provide the governing equation of motion. 

ax } cos<(), — bx 2 cos<)) 2 — aI w Q l cost^j +^7^02 cos(() 2 = cl B § 0 (6) 



where I w =I W +r m w . 



From Figure 3, the following relationships can be derived. The velocity diagram 
and the law of sine’s provide the following relationship between 0, and 0 2 . 




Figure 2: Dynamic force diagram 
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Figure 3: Kinematic velocity diagram 

Differentiating Equation (7) and Equation (8) and making substitutions and 
solving for 0 2 provide 



02 = 



0, sintj), sin(<t> 2 <t> 0 [4> 2 + s in <}), cos<t> 2 - (j), (a +b)cos§ l sin<t> 2 ] 

rsin(t> 2 sin((J) 2 - <t>i) 



(9) 



Likewise, solving for ({) 0 
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Combining Equation (6), Equation (9), and Equation (10) gives the equation for 
the angular acceleration of wheel 1 as a function of both wheels input torque and the 
angular velocity of the body. 



-0,rsin 2 ((|) 




9 



0 [/* sin(<f » 2 - 4*1 )[ a ^vv , ( <3 +^)cos(j), sin (t > 2 - bl w (a + ZOsincJ), cos<))2 - cl B r sin( 4> 2 - 4 ) i )] = 
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( 11 ) 



Equation (11) can be integrated to provide the angular velocity of wheel 1 for the 
input to the control algorithm. In this way, both torque inputs are combined into a single 
input necessary for use as one of the three inputs for the control algorithm. The other two 
inputs will be the two steering angular velocities. 

The next chapter develops the control for the vehicle and uses these three 
velocities as the inputs for the feedback control algorithm. From these three inputs to the 
control algorithm, the seven dimensional state vector provides the outputs of the vehicle’s 
position and orientation. 
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III. FEEDBACK CONTROL 



Considering the generalized coordinate vector q as the state vector, the kinematic 
model of the vehicle represented in the state space form is characterized by Equation (2) 
in which r\ is the input to the system. To control the position and orientation of the 
vehicle, the natural choice for the output equation is: 



y = h (q) = 



3\> 



_V 

Once the state equation and output equation are derived, the next step is to design 
a controller for this system. Feedback linearization technique is used [Ref. 10]. It has 
been shown that a static feedback is not capable of linearizing the system [Ref. 2] which 
will be repeated here. Furthermore, the dynamic feedback that linearizes and decouples 
the system will also be derived. 



A. STATIC FEEDBACK 



To derive a static nonlinear feedback, we differentiate the output equation. 
. <Hq) . dh(q) 



y = - 



dq 



-q = 



dq 



■S(^)T| = d>(^)ri 



where <I>(< 7 ) denotes the decoupling matrix of the system. If 0(g) is of full rank, we may 
apply a static feedback of the form 

to obtain the linearized closed-loop system: 

y = |l 

In the present case, the decoupling matrix is given by 

Sn(tf) 0 0 

*2i (<?) 0 0 

*5i (4> 0 °. 



dh(q) 

®(q)=-^S(q) = 

dq 
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which is unfortunately singular. Therefore, it is not possible to have a static feedback that 
linearizes the system. 



B. DYNAMIC FEEDBACK 



If a system is not linearizable by any static feedback, it may nevertheless be 
linearizable by a dynamic feedback. The construction of a dynamic feedback consists of 
two steps. First we construct a static feedback shown below, which is called Feedback I: 
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The application of this feedback results in the following closed-loop system: 

y = v i 
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It is noted that the first component of the output is linearized and decoupled from 
the other two components. Next, we apply another feedback in order to linearize the 
latter two components of the output. To do so, we differentiate them once more. 
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we may represent the above equation as follows: 
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Now applying Feedback II given by 
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the latter two outputs are linearized as 
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Furthermore, let |i, = v, , therefore 



Ti = v i 

The complete controller with three feedback loops for the steering angles and the 
wheel velocity input is depicted in a block diagram in Figure 4. Figure 5 shows the 
MATLAB Simulink program diagram. 

The simulation results are provided in the next chapter. The results showed a 
significant improvement in performance over the two-wheel steerable, one-wheel 
drivable vehicle. 
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Figure 4: Dynamic feedback controller 




Figure 5: MATLAB Simulink program 
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IV. SIMULATION 



A. TEST CONDITIONS 

The vehicle feedback control system shown in Figure 4 has been simulated using 
Matlab Simulink (Figure 5). Each block in the figure is implemented by the use of an S- 
function [Ref. 1 1]. To stabilize each of the linearized subsystems, the linear feedback is 
further designed. In the simulation, the linear feedback gain is chosen to place the poles 
of each subsystem at -5 and -15. The system was tested and compared to the performance 
of the dynamic control algorithm for the two steering, one wheel drivable vehicle. The 
following are the initial and goal configurations used for the test: 
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The parameters used for the simulation are designed to be realistic of an actual 
robot and in MKS units and are as follows: 

a = 0.55 b = 0.30 c = 0.25 

r = 0.10 I B = 2.0 I w = 0.05 

Figure 6 clearly shows that the path from the initial point to the goal is a straight 
line. This direct path was the result for the two steering wheel vehicle regardless if one or 
both wheels were powered. 
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B. INDEPENDENT CONTROL OF POSITION AND ORIENTATION 



Figure 7 through Figure 14 show the response of the two wheel drivable vehicle 
compared to the one wheel drivable vehicle for the same initial and final conditions used 
in the test. It is evident from Figure 7 to Figure 14 that in either case, both the position 
and orientation converge to the goal. This confirms that the position and orientation can 
be independently controlled. However the manner in which they reach the goal differ 
significantly. 

The vehicle with only one of the wheels drivable quickly accelerates and rotates 
early in the trajectory and then slowly approaches the goal. The vehicle with both wheels 
drivable has a steady velocity and rotation throughout the trajectory. This is especially 
evident in Figure 1 1 and Figure 12. The body angle versus time clearly show the 
differences between the two simulations, even though both trajectories follow a direct 
path to the goal. 

Both the constant rate of speed and constant rate of rotation of the body would be 
highly beneficial if there were on board sensors scanning the environment during the 
journey. 
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X and X dot 




Figure 7: Two wheel drivable vehicle (X: dashed, X dot: solid) 
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Y and Y dot 




Figure 9: Two wheel drivable vehicle (Y: dashed, Y dot: solid) 
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phi 0 (degrees) and phi 0 dot (deg/sec) phi g (degrees) and phi 0 dot (deg/sec) 




Figure 11: Two wheel drivable vehicle (phi: dashed, phi dot: solid) 




Figure 12: One wheel drivable vehicle (phi: dashed, phi dot: solid) 
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phi 1 and phi 2 (degrees) phi 1 and phi 2 (degrees) 




Figure 13: Two wheel drivable vehicle (phi 1: dashed, phi 2: solid) 
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c. 



ONE WHEEL VERSUS TWO WHEEL DRIVABLE VEHICLES 



Figure 15 and Figure 16 emphasize the differences between the one wheel 
drivable and two wheel drivable simulations. Even though both cases have two wheel 
steering, when both wheels are drivable, the transition from the initial starting point to the 
final goal point is much more linear than when only one wheel is powered. The body 
angle was adjusted by 90 degrees to the longitudinal axis of the vehicle, so that its 
orientation is from a more familiar perspective. 

In Figures 15 and 16, each frame of the vehicle represents the vehicle’s position, 
wheel angle, and the vehicles orientation at a particular point in time. Each snapshot is 
taken at equal intervals of time. These two figures clearly show that when only one wheel 
is being drivable it must approach the final goal point slowly to align to the correct 
orientation. When both wheels are drivable, the rotation of the vehicle is consistent 
throughout the trajectory. 
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V. CONCLUSION AND FUTURE WORK 



This thesis studied the control of a two-wheel vehicle with both wheels steerable 
and drivable. Unlike one-wheel steer mobile robots (e.g., the automobile/bicycle/tricycle 
type of mobile robots), the control of two-wheel steer robots are less intuitive and more 
difficult. By making both wheels drivable the complexity of the control algorithm 
increases further. Using a dynamic nonlinear feedback, independent control of the 
position and orientation of a mobile robot was obtained. The orientation is no longer an 
uncontrollable state variable governed by internal dynamics. Consequently, while the 
vehicle follows a direct path to its goal, its orientation does not have to be in the 
tangential direction of the path. For example, the orientation of the vehicle body can be 
independently controlled for scanning with onboard sensors. 

Further work on this project includes: 

The concept developed in this thesis can be extended to an all-wheel steering, all 
wheel drivable vehicle with four independent wheels. This may require redefining the 
constraint equations as well as the kinematic force and velocity equations may be 
required. 

Distribution of the torque between the wheels would be greatly beneficial if one 
of the wheels began to slip. This simulation used a constant torque value for each wheel 
initially, but later trials found that a constant torque divided by the angular speed of the 
wheel squared provided the best overall performance. More research is needed on how 
exactly to distribute the torque to each wheel depending on the steering angle, final and 
initial position and configuration, and surface conditions. 

It was stated from Equation (3) that the input velocities, r|, were chosen 
arbitrarily. Perhaps better performance could be obtained from using the two angular 
wheel velocities and one steering angular velocity for the input parameters. These new 
inputs would make each input torque independent of the other, allowing one of the 
wheels to slip. 



25 




26 



LIST OF REFERENCES 



1. Nomadic Technologies, Inc., Nomad 200 user’s guide, Technical report, 2133 
Leghorn Street, Mountain View, CA 94043, 1993. 

2. Yun, Xiaoping and Sarkar, Nilanjan, “Dynamic Feedback Control of Vehicles with 
Two Steerable Wheels,” Proceedings of 1996 IEEE International Conference on 
Robotics and Automation, pp 3105-31 10, Minneapolis, MN, April, 1996. 



3. DeCorte, Celeste, Holland, John and Marin, Antonio, “Security robots - a dual-use 
technology,” Defense Electronics, pp 19-2, September 1994. 

4. Furukawa, Y., “A review of four-wheeled steering studies from the viewpoint of 
vehicle dynamics and control,” Vehicle System Dynamics, pp 18(1 -3): 151-185, 1989. 

5. Yu, Ssu-Hsin and Moskwa, J., “A global approach to vehicle control: Coordination 
of four wheel steering and wheel torque,” Journal of Dynamic Systems, Measurement 
and Control, pp 116:659-667, December 1994. 

6. Bushnell, L. G., Tilbury, D. M. and Sastry, S. S., “Steering three-input nonholonomic 
systems: The fire truck example,” International Journal of Robotics Research, pp 
14(4):366-381, August 1995. 

7. Kanayama, Y., “Two dimensional wheeled vehicle kinematics,” Proceedings of 1994 
International Conference on Robotics and Automation, pp 3079-3084, San Diego, CA, 
May 1994. 



8. Borenstein, J., “Control and kinematic design of multi-degree-of-freedom mobile 
robots with compliant linkage,” IEEE Transactions on Robotics and Automation, pp 
1 1 ( 1):2 1-35, February 1995. 

9. Novel, B. d’ Andrea , Bastin, B., and Campion, G., “Dynamic feedback linearization of 
nonholonomic wheeled mobile robots,” Proceedings of 1992 International Conference on 
Robotics and Automation, pp 2527-2532, Nice, France, May 1992. 



10. Nijmeijer, H., and van der Schaft, A. J., Nonlinear Dynamic Control Systems, 
Springer-Verlag, New York, 1990. 



27 



1 1. The MathWorks, Inc., Simulink user’s guide. Technical report, 24 Prime Park Way, 
Natick, MA 01760, 1995. 



28 



INITIAL DISTRIBUTION LIST 



1. Defense Technical Information Center 2 

8725 John J. Kingman Rd., Ste 0944 

Ft. Belvoir, VA 22060-6218 

2. Dudley Knox Library 2 

Naval Postgraduate School 

41 1 Dyer Rd. 

Monterey, CA 93943-5101 

3. Chairman, Code EC 1 

Department of Electrical and Computer Engineering 

Naval Postgraduate School 
Monterey, CA 93943-5121 

4. Prof. Xiaoping Yun, Code EC/Yx 2 

Department of Electrical and Computer Engineering 

Naval Postgraduate School 
Monterey, CA 93943-5121 

5. Prof. Roberto Cristi, Code EC/Cr 1 

Department of Electrical and Computer Engineering 

Naval Postgraduate School 
Monterey, CA 93943-5121 

6. Lt. Douglas R. Gerrard 6 

719 Nacional Court 

Salinas, CA 93901-4703 



29 










• ‘ 



1 




DUDLEY KNOX LIBRARY 



3 2768 00341287 5 



i 




